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Abstract — The development of cooperative vehicle safety 
(CVS) applications, such as collision warnings, turning assis- 
tants, and speed advisories, etc., has received great attention in 
the past few years. Accurate vehicular localization is essential 
to enable these applications. In this study, motivated by the 
proliferation of the Global Positioning System (GPS) devices, 
and the increasing sophistication of wireless communication 
technologies in vehicular networks, we propose a distributed 
location estimate algorithm to improve the positioning accu- 
racy via cooperative inter-vehicle distance measurement. In 
particular, we compute the inter-vehicle distance based on 
raw GPS pseudorange measurements, instead of depending 
on traditional radio-based ranging techniques, which usually 
either suffer from high hardware cost or have inadequate 
positioning accuracy. In addition, we improve the estimation of 
the vehicles' locations only based on the inaccurate GPS fixes, 
without using any anchors with known exact locations. The 
algorithm is decentralized, which enhances its practicability 
in highly dynamic vehicular networks. We have developed a 
simulation model to evaluate the performance of the proposed 
algorithm, and the results demonstrate that the algorithm can 
significantly improve the positioning accuracy. 

I. Introduction 

With recent advances in wireless communication technolo- 
gies in vehicular networks, the cooperative vehicle safety 
(CVS) applications are expected to offer fundamental break- 
throughs in enhancing the road safety. Accurate vehicle 
positioning is vital to enabling many safety-critical ap- 
plications, such as cooperative collision warnings, turning 
assistants, and speed advisories, to name but a few. In 
these applications, the positioning has to be accurate enough 
such that the vehicles could be differentiated at the lane 
level. However, current commercially available GPS devices, 
which are widely used in ground vehicles for positioning 
and navigation, typically report errors on the order of 10 
meters ([1], [2]). Thus, it is difficult to recover the lane level 
relationship among vehicles within a vicinity region. 

Much effort has been devoted to increasing the positioning 
accuracy in vehicular networks. Leveraging reference points 
(i.e. anchors or base stations) with known exact positions is 
one of the most prevalent solutions to correct the positioning 
error. Differential GPS (DGPS) and assisted GPS (A-GPS) 
are two of the well-known techniques relying on ground- 
based reference points to improve the GPS accuracy. Many 
localization systems in vehicular networks have employed 
similar concepts [3]. R. W. Ouyang et al. [4] utilized the 
time of arrival (TOA) measurement taken from terrestrial ref- 



erence stations to improve the initial GPS fix accuracy. Three 
algorithms, including a geometric approach, a weighted least 
squares based approach and a closed-form approach, are pro- 
posed to enhance the positioning performance under different 
driving conditions. Inspired by the concept of DGPS, E.K 
Lee et al. [5] proposed a mobile version of DGPS system, 
which exploits the radio-frequency identification (RFID) 
technique in vehicle positioning. In the proposed system, 
when a vehicle obtains a known precise position from an 
RFID tag installed along the road via its RFID reader, this 
vehicle would act as a moving reference point temporarily by 
computing the GPS errors, and then sharing the errors with 
its neighbors to help them correct their GPS coordinates. 
Although most of the localization systems based on reference 
points have been demonstrated effective, they require the 
support of particular hardwares or large-scale infrastructures, 
while some of them are not yet globally available. 

Currently, GPS becomes a mature and widely applied 
localization system. The proliferation of GPS makes it the de 
facto solution for vehicle navigation and localization, though 
it still suffers from some issues such as accuracy, reliability, 
and robustness to varying degrees. Meanwhile, the increasing 
sophistication of wireless communication technologies in 
vehicular networks, such as the dedicated short range com- 
munications (DSRC), encourages the development of coop- 
erative applications [6]. Motivated by the above observations, 
in this work, we are dedicated to improving the positioning 
accuracy based on GPS pseudorange measurements in a 
cooperative vehicular network. 

The main contributions of this work are summarized as 
follows. First, existing solutions which utilize inter- vehicle 
distances in improving the positioning accuracy ([7], [8], [9], 
[10]), in one way or another, rely on the radio-based ranging 
technologies, such as Time of Arrival (To A) [4], Time Differ- 
ence of Arrival (TDoA) [11], Angle-of-arrival (AOA) [12], 
and Received Signal Strength (RSS) [13]. Typically, these 
technologies either require particular ranging sensors causing 
a high hardware cost, or suffer from inadequate ranging 
accuracy [14]. In contrast, the proposed algorithm is designed 
to compute inter-vehicle distances with high accuracy only 
by the acquisition of GPS information without using ranging 
sensors. Second, the proposed algorithm estimates the vehi- 
cle location solely based on inaccurate GPS measurements 
without the assumption of any reference points. Last, in 
view of the highly dynamic nature in vehicular networks, 



the proposed algorithm is operated in a distributed fashion 
to make it a potentially practical solution. Note that this study 
focuses on improving the positioning accuracy in open areas 
with reasonably good GPS signal (i.e. at least four satellites 
available for localization), such as highways, suburban areas, 
and rural areas, etc. Nevertheless, in other environments, 
solutions for compensating GPS outages and overcoming 
GPS limitations can be referred to ([7], [8], [9], [15]). 

The rest of this paper is organized as follows. Section HJ 
reviews the inter-vehicle distance detection technique and 
formulates the research problem. Section UTT] proposes a 
distributed location estimate algorithm. Section |IV] develops 
the simulation model and gives the performance evaluation. 
Last, we conclude this study and outline the further work in 
Section [VJ 

II. Preliminary 
A. GPS pseudorange based distance measurement 

Many studies on cooperative vehicular localization assume 
the availability of the distance between two neighboring vehi- 
cles to improve the positioning accuracy. Typical techniques 
assumed to obtain the inter-vehicle distance include ToA, 
TDoA, AOA, and RSS, which are the radio-based rang- 
ing techniques proposed in cellular networks. In vehicular 
networks, however, these techniques can hardly achieve the 
ranging accuracy required by safety-critical applications [14]. 
In order to improve the accuracy of inter-vehicle distance 
measurement, we have proposed an algorithm based on the 
sharing of GPS pseudorange information [16]. In this section, 
we recapitulate the key ideas of the algorithm, which forms 
the basis of this study. 

In the GPS system, the distance from a vehicle to each 
satellite is derived from an estimated time of transmission, 
and this distance is called the pseudorange. Several sources 
contribute to the errors in the pseudorange measurement. The 
pseudorange (PR l a ) between GPS receiver a to satellite i can 
be decomposed into [17]: 



PR l n — R l n + tn 



■el 



(1) 



where R l a is the true distance between satellite i and receiver 
a\ t a is the error caused by receiver a's clock bias; x l is 
the common noise related to satellite i that are shared by 
each GPS receiver within a vicinity region, including satellite 
clock bias, atmospheric delay, and errors in the broadcasted 
ephemeris; £ l a is the non-common noise specific to receiver a 
and satellite i , including the multipath and code acquisition 
noises. By taking the difference between the pseudoranges 
of the two receivers a and b to the same satellite i , the 
common noise due to satellite i can be effectively removed: 
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where S l ab is the single difference of pseudorange measure- 
ments, and AR l ab is the difference between the true ranges 
from receiver a and b to satellite i . As the true ranges 




Fig. 1. Pseudorange double difference 



from satellite i to receivers a and b are much larger than the 
distance between a and b , the two vectors pointing from i 
to a and b are nearly parallel to each other. As illustrated in 
Figure [T] AR l ab can thus be approximated by: 



ARl 



ab ' 



e -r ab 



(3) 



where e l is the unit vector pointing from receiver a (or b) to 
satellite i, and r ab is the distance vector between the receivers 
a and b. When double difference is used, the clock bias of 
the receivers a and b can be further removed. 



^ab 



= [A/4-A/^ + [(4-4)-( £ i- e ^ 

= [^-e j }-7 ab + [(e' a -ei)-(ei-el)} (4) 

Given a set of satellites {0, 1, shared by the receivers 
a and b, EqHcan be reorganized into: 



D ab Uf ab + £ 



(5) 



where D ab is the column vector of pseudorange double 
differences with respect to the satellites and i (1 < 
i < n\ and D ab = [D™ ••• Df b ] T . Accordingly, H is 
the column vector of the difference between two unit 



vectors, and H = [(e — <r) (e 



) ••• (e^-^)] T . £ 



is the column vector of aggregated non-common noises, 
and e = [(( £ j -el)- ( £fl ° - £fe )) ... ((£ - e" b ) - - £ ° b ))] T . 
Assume £ is zero mean and equal variance, r ab can be 
approximately solved by the linear least squares estimator: 



Tab = (H r H) 



~ l H T D ab 



(6) 



In order to further improve the accuracy of the computed 
distance f ab , we have taken the Carrier to Noise Ratio (CNR) 
of raw pseudorange measurements into account for noise 
mitigation, and proposed an algorithm called weighted least 
squares double difference (WLS-DD). The final form of the 
weight matrix W is represented by: 



W = diag 



1\2 



(C) 2 -(C) 2 
(€) 2 + (C) 2 



l\2. 



(7) 



where diag(-) denotes a diagonal matrix, and is the CNR 
value of the received signal from satellite i to receiver a. 



The detailed designing rationale of the weight matrix W can 
be referred to [16]. Finally, the distance between a and b is 
computed by: 



TABLE I 

Summary of notations 



r ab = (H r WH)" 1 H r WD, 
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We have demonstrated that the WLS-DD significantly 
increases the accuracy of the distance measurement via an 
extensive field testing. On the basis of the accurate distance 
measurement, we formulate the research problem of this 
study as follows. 

B. Problem statement 

The set of vehicles is denoted by V = {vi, V2, v |v|}> 
where |V| is the total number of vehicles. The true location 
of vehicle v,- (1 <i< \V\) is represented by the vector v/. Vj 
is considered as the neighbor of v* if the two vehicles are 
within their communication range. The set of Vj's neighbors 
is denoted by Ni (Ni C V). For Vv/ G Ni, the true distance 
between v/ and vj is denoted by dij (dij = \\\i — v/||), while 
the computed distance (by WLS-DD) between v; and v/ is 
denoted by dij. Denote the original GPS fix of v ; as v/, which 
is typically subject to the positioning error on the order of 10 
meters ([1], [2]). Note that the accuracy of the inter- vehicle 
distance computed by WLS-DD is much higher than that 
directly obtained from the original GPS fixes of the two 
neighboring vehicles, which is ||vj — \j\\. 

The overall objective of this work is to improve the accu- 
racy of vehicular localization by leveraging the original GPS 
fixes and the computed inter- vehicle distances. Specifically, 
given a set of vehicles V with their original GPS fixes 
v = {vi,V2, viy|}, and the computed distance dij between 
any two neighboring vehicles v* and Vj (v; G V and Vj G Ni), 
the algorithm is committed to computing a set of estimated 
locations v = {vi, $2, V|y|}, so that the estimated location 
\i can approximate to the true location Vj. In brief, the 

|v| 

problem is to minimize the value of £ ||v/ — V/||, which is 

i=l 

the overall error of the estimated locations. It is worth noting 
that, we aim to improve the positioning accuracy solely 
based on the inaccurate raw GPS measurements without the 
assumption of any particular equipments or infrastructures 
(i.e. ranging sensors for distance measurement, or anchors 
for error correction). The primary notations used in this work 
are summarized in Table U 

III. A Distributed Location Estimate Algorithm 

In this section, we propose a distributed location estimate 
algorithm (DLEA) to improve the localization accuracy in 
a cooperative vehicular network. The detailed procedures of 
DLEA along with its designing rationale are presented below. 

A. Tentative location estimate 

A prerequisite to enable the cooperative localization is 
that, for any vehicle v* (v; G V), there is at least one neighbor- 
ing vehicle Vj (vj G V), namely, Ni ^ for Vv; G V. With this 
prerequisite, each vehicle v/ is able to estimate the location 
based on the information (i.e., computed distances, and 



Notations 


Descriptions 


Notes 


V 


total set of vehicles 


V = {vi,V2,...,V|y|} 


Ni 


neighbor set of V; 


Nj C V 


V k 


subset of vehicles with 


V k =N k + {v k ] 




the pivot Vjt 


and V k <ZV 


V/ 


true location of Vj 






true distance between 
Vi and Vj 


d ij = h-vj\\ 




original GPS fix of Vj 




dij 


computed distance between 
Vi and Vj 


computed by WLS-DD 


Oi 


GPS error of V; 


Si = V; - Vj 


vf 


tentative estimated location 
of Vi in subset V k 




Vj 


final estimated location of Vi 




V* 


set of tentative estimated 
locations computed by v\ 




Wi 


weight of the pivot Vi 





original GPS fixes) received from its neighbors. To facilitate 
the implementation of the distributed location estimate, we 
define the subset of vehicles as follows. 

Definition 1: subset of vehicles Given a vehicle 
(v^ G V), it is considered as a pivot of a subset V k , when 
V k is comprised of and all of its neighbors {vj\vj G A^}, 
namely, V k =N k + {v k }. 

Note that each vehicle will act as a pivot and construct 
a corresponding subset V k . In the following, we transform 
the tentative location estimate into a constrained non-linear 
optimization problem. In this way, each pivot vehicle 
will compute a set of tentative estimated locations, which is 
represented by = {vf |v/ G V k }, where \ k is the tentative 
estimated location for v ; (v/ G V k ). 

Given a vehicle v ; (v; G V k ) with its original GPS fix Vj, 
the GPS error 5/ can be represented by Si = v ; — v,-, where 
V; is the true location of V;. Since the GPS error is caused 
by many independent sources, such as satellite clock bias, 
atmospheric delay, acquisition noises , and multipath, etc., it 
is commonly to assume that the error 5 follows the Gaussian 
distribution ([7], [15]), namely, 5 ~ N(fl,G 2 ), where \i is 
the mean, and a 2 is the variance. Denote the probability 



density function as <p(5), then <p(5) = 
the (p(8), the value of the error (v/ 



(5-M) Z 

• e 2a 2 . Given 



■vi) is most likely to 
distribute around the point where the highest probability 
density is achieved. Therefore, in order to maximize the 
possibility that the tentative estimated location (\ k ) would 
approximate to the true location (v/), it is expected to 
maximize the function of (p(y k — Vj). Besides, the tentative 
estimated locations should also satisfy the distance constraint 
between any two neighboring vehicles, which is represented 



by: 



y k - \ h k 



- djk, for Vv 7 - G Nk, where djk is the computed 



distance between the pivot and its neighbor Vj. In practice, 




Vj, and the error 5/ can be expanded to: v\(y\ x , vf ), v/(v^ , v^), 
and Si(8i x ,Si y ), respectively. Accordingly, the objective func- 
tion is decomposed into <p(v^ — Vi x ) ■ (p(v| — v^). Given the 
mean value ^(/i*,/^), and the standard deviation <7(<7 X , <7y), 
we have: 



1 



2;ra x 
1 



and 



(v k - 



2a2 



27T<X 



(ID 



Fig. 2. An example 



the road space constraint (e.g. boundary coordinates), if 
applicable, can be also included to enhance the positioning 
accuracy. To sum up, the set of tentative estimated locations 
computed by the pivot can be derived from: 



y 



The set of tentative estimated locations is computed by: 
V* = argnmx £ cp(v k x - v ix ) • <p(v| - v iy ) (12) 



v* 



ViEV k 



- argmax 
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I <P(vf- 
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According to Eq[TTJ let 

M = <p(vt -%)•</>(< 

1 -«H 
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- djk for Vvy G Nk, and 
for Vv^GV*. 
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where 



where ^ _ 

V k is the subset with the pivot vehicle v^; 

\ k is the tentative estimated location for v,- computed by v^; anc [ 
v* is the original GPS fix of v,-; 

Jy^ is the computed distance between vj and v^; ^ = 1°S 

Nk is the neighbor set of v^; 
^ represents the road space constraint. 
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B. An example 

We illustrate the computing details of for the tentative 
estimated locations by the following example. As shown in 
Figure [2 given the road space , the total set of vehicles 
is V = {vi,V2,V3,V4,V5,V6}. The edge with double arrows 
represents the two vehicles are within their communication 
range. In other words, they can share the GPS pseudorange 
measurement with each other and compute the inter- vehicle 
distance. Taken v\ as an example, the neighbor set of vi is 
represented by N\ = {v2, V3 , V4, V5}, and the subset of vehicles 
with pivot vi is V 1 = {vi,V2,V3,V4,V5}. The set of tentative 
estimated locations V 1 = {v}, \\, V3, V4, v\} is computed by: 

V 1 = argmax ((p(\\ - vi) + <p(v\ ^2)- + 9(^5 - V5)) (10) 
Subject to that 



Since B is a constant, the objective of maximizing the value 
of M is equivalent to the objective of minimizing the value 
of A. Accordingly, EqOcan be transformed to: 



\ k — argmm ^ 



yk 



2o? 



20* 



(13) 



subject to that 



( v l-^) 2 + ( v t- v t) 2 = ^ for VvjEN^and 

sib<4L<Syb> 
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for W;GV\ 
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and 
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for Vv/GV 1 



To solve the above constrained non-linear optimiza- 
tion problem, for clear exposition, we consider in a two- 
dimension space. Nevertheless, note that it is straightforward 
to extend the solution into a three-dimension space. In an x-y 
coordinate, the tentative estimated location vf, the GPS fix 



where Sf b ,S^ b ,S y lb , and S y ub represent the lower bound and the 
upper bound of the x and y coordinates confined by the road 
space, respectively. 

C. Final location estimate 

With the above method, each vehicle (v& G V), when 
acting as a pivot, will compute in total of \V k \ tentative 
estimated locations, including \ k (for itself) and a set {vf |v/ G 
N^} for each of its neighbors (|V*| = \N%\ + 1). This implies 
that, each vehicle will also obtain in total of |V*| tentative 
estimated locations, including \ k k computed by itself, and a 
set {\ l k \vi G Nk} computed by each of its neighbor v/ (when 
Vi acting as a pivot). Intuitively, given a pivot vjt, the more 
vehicles are within the subset V k , the higher possibility that 
the computed v\ is closer to the true location of vu as there 



are more constraints (i.e., distances between two neighboring 
vehicles) are applied in position estimate. In view of this, we 
define the weight of a pivot vehicle as follows. 

Definition 2: weight of a pivot vehicle Given a pivot 
Vk with its corresponding subset V k , the weight of v&, denoted 
by w^, is defined as the number of vehicles in V k , namely, 
w k =\V k \. 

The final estimated location v^ is a weighted average of all 
the tentative estimated locations for ({v^} + {\ l k \ v/ G A^}), 
and the set is equivalent to {v s k \v s G V k }, where \ s k is the 
tentative estimated location for computed by the pivot v s . 
The weight of \ s k is defined as follows. 

Definition 3: weight of a tentative estimated location 

Given a tentative estimated location for Vk computed by the 
pivot v s (vjp, the weight of \ s k is defined as the weight of v s 
(w s ) over the sum of the weight of each V{ in the subset V k , 
which is calculated by ™ s w . . 

ViEV k 

With the above definitions, the final estimated location v^ 
is a linear combination of all the tentative estimated locations 



TABLE II 

Default settings 



v|, which is computed by: 

♦*= E 

v s ev k 



(14) 



E wt K 

Vi ev k 

Taken v^ shown in Figure [2] as an example, the subset V 6 = 
{v4,V5,V6}. Therefore, v^ will get three tentative estimated 
locations, v^, and v^, which are computed by V4, V5, and 
V6, respectively. Besides, the weight of each pivot vehicle is 
W4 = 4, W5 = 4, and = 2. So, the final estimated location 
is computed by: 

\ 6 ■ - ; • (W 4 v£ + W 5 \ 5 6 + H^Vg) 



W4 + W5 + W6 

The main procedures of DLEA is summarized as follows. 
Step 1: To compute the distance between any two neigh- 
boring vehicles based on WLS-DD. 

Step 2: Each vehicle v/ shares its original GPS fix v/ with 
its neighbors. 

Step 3: Each vehicle v* acts as a pivot and computes a set 
of tentative estimated locations V. 

Step 4: Each vehicle v; shares the computed V with its 
neighbors. 

Step 5: Each vehicle v/ computes its final estimated 
location v* based on all of its tentative estimated locations. 

IV. Performance Evaluation 

In this section, we evaluate the performance of DLEA. The 
framework of the simulation model is built by CSIM19 [18], 
and DLEA is implemented by the C programming together 
with the MATLAB. Table [2 shows the default parameter 
settings for performance evaluation. Unless stated otherwise, 
the simulations are conducted under these default settings. 
Specifically, we consider in a (LxW) m 2 road space, where 
the true locations of vehicles spatially form a Poisson process 
with the mean arrival rate, A, and the mean velocity, q. The 



Parameter 


Default 


Descriptions 


L 


500 (m) 


length of the road space 


W 


9(m) 


width of the road space 
(3 lanes x 3m) 


R 


150 (m) 


communication range 


X 


50 (vehicles/min) 


parameter of the Poisson process 


q 


50 (km/h) 


mean velocity of vehicles 


8 


<5~iV(0,10 2 ) 


error of GPS fixes 
(Gaussian distribution) 


£ 


£~Af(0,l 2 ) 


error of computed distances 
(Gaussian distribution) 



GPS fix error (5), as well as the error of the computed 
inter-vehicle distances (£), follow the Gaussian distribution. 
The default communication range (R) among vehicles is 
assumed to be 150 meters, which is within the reliable data 
transmission range supported by the DSRC [19]. 

As shown in Figure [3] we evaluate the performance of 
DLEA under different GPS deviation environments. The x- 
axis represents the IDs of vehicles along the road. The y-axis 
represents the location error of each vehicle. In particular, the 
errors of GPS fixes and DLEA are depicted for comparison, 
which are calculated by ||v/ — v/|| and ||v/ — v/||, respectively. 
Clearly, compared with the GPS fixes, the estimated locations 
by DLEA are much closer to the true locations of vehicles. To 
give a comprehensive comparison, Table UTT] summarizes the 
average errors of GPS fixes and DLEA, which are calculated 
by E ||v/-v/||/|V| and I ||v/ - v/||/|V|, respectively. Ob- 

v/GV v/GV 

served from these statistics, with an increasing value of GPS 
deviation, the errors of both GPS fixes and DLEA are getting 
higher. This is reasonable as DLEA estimates the locations 
based on the original GPS fixes. Nevertheless, DLEA always 
manages to achieve much higher accuracy than GPS fixes 
across a wide range of conditions. 

TABLE III 

Average location errors (m) 





GPS Fix 


DLEA 


Deviation=5m 


6.271441 


2.552837 


Deviation=10m 


14.119025 


3.791405 


Deviation=15m 


20.852989 


5.678821 



V. Conclusion and Future Work 

In this work, motivated by the urgent demand of accu- 
rate vehicular localization in safety-critial applications, we 
proposed a distributed location estimate algorithm, DLEA, 
to improve the positioning accuracy via cooperative inter- 
vehicle distance measurement. The implementation of DLEA 
only relies on raw GPS pseudorange measurements without 
the assumption of any particular hardwares or infrastruc- 
tures, which makes it a potentially inexpensive and prac- 
tical solution. Besides, DLEA is operated in a distributed 
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Fig. 3. Performance evaluation under different GPS deviation environments 

fashion, so that it can be adaptable to the highly dynamic 
vehicular network. Last, we have built the simulation model, 
and implemented the algorithm for performance evaluation. 
The simulation results demonstrated that the algorithm can 
significantly improve the positioning accuracy. 

The current solution is effective in scenarios with good 
GPS signal. In our future work, we will explore the influence 
of GPS signal to the positioning performance under different 
environments, such that we can further refine the solution and 
make it more robust in compensating and overcoming GPS 
limitations. 
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